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This  paper  presents  an  integrated  guidance  and  control  design  for  formation  flight 
using  a  combination  of  adaptive  output  feedback  and  backstepping  techniques  without  an 
underlying  time-scale  separation  assumption.  We  formulate  the  problem  as  an  adaptive 
output  feedback  control  problem  for  a  line-of-sight  (LOS)  based  formation  flight 
configuration  of  a  leader  and  a  follower  aircraft.  The  design  objective  is  to  regulate  range 
and  two  bearing  angle  rates  while  maintaining  turn  coordination.  Adaptive  neural  networks 
are  trained  online  with  available  measurements  to  compensate  for  unmodeled  nonlinearities 
in  the  design  process.  These  include  uncertainties  due  to  unknown  leader  aircraft 
acceleration,  and  the  modeling  error  due  to  parametric  uncertainties  in  the  aircraft 
aerodynamic  derivatives.  One  benefit  of  this  approach  is  that  the  guidance  and  flight  control 
design  process  is  integrated.  Simulation  results  using  a  nonlinear  6DOF  simulation  model 
are  presented  to  illustrate  the  efficacy  of  the  approach  by  comparing  the  performance  with  a 
time-scale  separation  based  design. 


I.  Introduction 

AS  demonstrated  in  recent  conflicts,  unmanned  aerial  vehicles  (UAVs)  are  becoming  an  important  component  of 
our  military  force  structure.  UAVs,  operating  in  close  proximity  to  enemy  forces,  provide  real-time 
information  difficult  to  obtain  from  other  sources,  without  risk  to  human  pilots.  Among  the  strategies  employed  by 
these  UAVs  will  be  flocks  of  cooperative  MAVs  operating  in  close  proximity  to  terrain  or  structures  that  will  gather 
information  and,  under  human  supervision,  seek  out,  identify,  and  engage  targets.  They  will  be  expected  to  maintain 
a  formation  while  at  the  same  time  executing  searches  in  a  congested  environment.  Stealth  like  operations  will  also 
be  important,  implying  the  need  to  maintain  autonomy  and  to  minimize  communication.  Maintaining  a  formation  is 
also  important  from  this  perspective  so  that  passive  sensing  can  be  used  to  ascertain  the  locations  and  behaviors  of 
cooperating  MAVs/UAVs. 

The  problem  of  leader-follower  formation  flight  in  which  the  follower  aircraft  is  equipped  with  only  an  onboard 
camera  to  track  the  leader  aircraft  is  quite  challenging.  This  problem  requires  simultaneous  sensor  data  processing, 
state  estimation  and  tracking  control  in  the  presence  of  unmodeled  disturbances  (leader  acceleration)  and 
measurement  uncertainties.  Sensor  data  processing  involves  fast  converging  image  processing  algorithms  that  track 
the  leader  aircraft  in  the  presence  of  background  clutter  and  derive  noisy  measurements  of  the  leader  aircraft’s 
position  relative  to  itself  1 2.  A  consequence  of  using  a  monocular  fixed  camera  is  that  the  range  becomes 
unobservable.  So  the  measurements  from  the  image  processing  algorithm  are  fed  into  a  nonlinear  filter,  e.g.,  an 
Extended  Kalman  Filter  (EKF),  which  computes  estimates  of  range  and  other  line-of-sight  (LOS)  variables  that  are 
required  in  the  guidance  and  control  algorithms  ’.  Assuming  that  we  have  useful  estimates  of  the  range  and  other 
required  LOS  variables,  regulating  these  variables  to  desired  values  is  not  an  easy  problem.  In  Ref.  3,  an  adaptive 
guidance  algorithm  and  an  adaptive  autopilot  were  designed  separately  using  time-scale  separation  argument,  and 
then  integrated  together  to  enable  the  follower  aircraft  to  maintain  close  range  (about  two  wing-span  lengths)  from  a 
maneuvering  leader  aircraft.  True  values  of  range  and  LOS  azimuth  and  elevation  angles  were  assumed,  i.e.,  the 
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image  processing  and  nonlinear  state  filters  were  not  implemented.  Even  in  this  case,  it  was  found  that  the  leader 
acceleration  has  a  degrading  effect  on  the  range  tracking  performance.  It  was  observed  that  when  the  leader 
maneuver  was  severe,  for  example  a  sharp  heading  change,  the  guidance  algorithm  of  the  follower  would  send  large 
commands  to  the  autopilot  and  cause  the  actuators  to  saturate.  Consequently,  the  guidance  commands  to  the 
autopilot  were  scaled  down  by  a  fixed  factor  to  ensure  closed-loop  stability  for  a  range  of  leader  aircraft  maneuvers  \ 
This  scaling  factor  was  arrived  at  after  several  simulation  runs.  The  scaling  down  of  the  guidance  commands 
resulted  in  larger  overshoots  from  the  commanded  range  as  the  severity  of  the  leader  maneuver  increased.  Hence 
performance  was  compromised  to  ensure  stability. 

Conventional  approaches  to  guidance  and  flight  control  design  employ  a  time-scale  separation  argument  to 
justify  the  separate  design  of  the  guidance  and  autopilot  subsystems.  Once  designed,  the  two  subsystems  are 
integrated  together  and  tuned  till  the  performance  objectives  are  satisfied.  While  this  approach  to  design  has  been 
successfully  implemented  on  many  flight  vehicle  systems,  the  design  usually  results  in  an  overall  performance  that 
is  less  than  what  can  be  achieved.  This  is  because  the  conventional  approach  ignores  the  coupling  between  the 
guidance  and  autopilot  subsystems.  Secondly,  in  high  performance  applications  like  intercepting  a  highly 
maneuvering  target,  or  maintaining  range  from  a  maneuvering  leader  aircraft  in  a  formation,  the  time-scale 
separation  argument  does  not  hold.  In  such  cases  the  guidance  subsystem  can  drive  the  autopilot  and  the  overall 
system  unstable  with  commands  that  cannot  be  achieved  by  the  autopilot.  Integrated  approaches  to  guidance  and 
control  design  have  been  indicated  in  literature  as  a  way  to  overcome  the  shortcomings  of  the  conventional  approach. 
Its  been  stated  that  an  integrated  guidance  and  control  (IGC)  formulation  can  directly  compensate  for  the  effect  of 
autopilot  lag  and  improve  missile  intercept  performance  4'5.  An  integrated  approach  also  helps  avoid  the  iterative 
procedure  involved  in  tuning  the  guidance  and  autopilot  subsystems,  if  designed  separately.  The  integrated  design  is 
also  less  susceptible  to  saturation  and  stability  problems.  Feedback  linearization  of  the  relative  cross-range  and 
altitude  to  target  and  the  roll-angle  is  employed  in  Refs.  4-5  for  the  IGC  formulation.  Sliding  mode  control  theory  is 
employed  in  Ref.  6  for  the  IGC  formulation.  In  Ref.  7,  a  single-plane  linear  IGC  problem  formulation  is  considered 
and  a  game-theoretic  control  synthesis  approach  is  utilized.  In  Ref.  8,  the  IGC  problem  is  formulated  as  a  finite-time 
horizon  nonlinear  disturbance  attenuation  problem.  An  approximate  solution  approach  to  the  above  problem  is 
developed  that  is  referred  to  as  the  state-dependent  Riccati  differential  (difference)  equation  (SDRDE)  technique. 
Monte  Carlo  simulation  results  using  this  technique  showed  that  it  performed  favorably  compared  to  a  benchmark 
guidance  and  control  system  and  resulted  in  much  smaller  overall  system  time  constants.  The  SDRDE  technique 
however  is  computationally  intensive  owing  to  the  need  to  solve  Riccati  difference  equations  online  at  each  sample 
instant.  An  adaptive  backstepping  based  approach  to  IGC  design  is  presented  in  Ref.  9.  The  missile  dynamics  have 
to  be  written  in  the  strict-feedback  form  10  in  order  to  use  the  backstepping  approach.  The  advantage  is  that  the 
backstepping  approach  can  directly  address  plants  with  unmatched  uncertainties.  Adaptation  is  included  to  provide 
robustness  to  parametric  uncertainty  in  the  missile  dynamics.  In  Ref.  11,  the  flight  control  system  design  is  done  via 
a  conventional  inner  and  outer-loop  design  approach.  The  linear  compensator  gains  in  the  inner  and  outer-loops  are 
chosen  such  that  the  combined  error  dynamics  of  both  the  loops  are  asymptotically  stable  in  the  absence  of  modeling 
uncertainties,  and  thus  mitigate  inner  and  outer-loop  interaction.  Adaptation  is  included  in  both  loops  to  address  any 
modeling  uncertainties.  Pseudo-Control  Hedging  12  is  used  in  the  inner-loop  to  prevent  adaptation  to  actuator 
saturation  and  dynamics.  Hedging  is  also  used  in  the  outer-loop  to  prevent  adaptation  to  inner-loop  dynamics. 

The  contribution  of  this  paper  lies  in  presenting  an  adaptive  approach  to  IGC  design  for  a  LOS  based  formation 
flight  configuration  of  a  leader  and  a  follower  aircraft.  The  design  objective  is  to  regulate  range  and  two  bearing 
angle  rates  to  specified  values  while  maintaining  turn  coordination.  The  bearing  angles  are  defined  to  be  the  angles 
between  the  LOS  vector  to  the  leader  aircraft  and  the  optical  axis  of  the  camera,  which  is  assumed  to  be  fixed  to  the 
body-frame  of  the  follower  aircraft.  We  assume  that  estimates  of  these  LOS  variables  are  available  from  the  use  of 
on  board  vision  sensors  and  nonlinear  filtering  algorithms  1'17.  These  LOS  variables  are  differentiated  until  the 
actuator  deflection  terms  appear.  We  show  the  existence  of  a  well-defined  vector  relative  degree  15  for  the  MIMO 
system  of  the  LOS  variables  with  respect  to  the  actuator  deflections.  Then  we  perform  approximate  dynamic 
inversion  of  the  LOS  variable  dynamics.  Adaptive  neural  networks  are  trained  online  with  available  measurements 
to  compensate  for  unmodeled  nonlinearities  in  the  design  process.  These  include  uncertainties  due  to  unknown 
leader  aircraft  acceleration,  and  the  modeling  error  due  to  parametric  uncertainties  in  the  aircraft  aerodynamic 
derivatives.  However,  in  order  to  improve  turn  coordination  performance  and  efficiency  in  controlling  the  azimuth 
bearing  angle  rate,  the  design  of  the  LOS  azimuth  channel  is  modified  using  an  adaptive  backstepping  algorithm. 
One  benefit  of  this  approach  is  that  the  guidance  and  flight  control  design  process  is  integrated.  Furthermore,  on-line 
adaptation  imbues  the  integrated  system  with  robustness  to  the  unmodeled  nonlinearities.  This  has  a  secondary 
benefit  of  streamlining  the  design  approach.  Simulation  results  using  a  nonlinear  6DOF  simulation  model  are 
presented  to  illustrate  the  efficacy  of  the  approach  by  comparing  the  performance  with  a  time-scale  separation  based 
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design. 

The  organization  of  the  paper  is  as  follows.  Section  II  provides  general  information  about  LOS-based  formation 
flight  for  UAVs.  Section  III  derives  the  LOS  variable  dynamics  and  shows  existence  of  well-defined  vector  relative 
degree  for  this  problem.  The  control  design  formulation  is  described  in  detail  with  a  summary  of  the  relevant  theory. 
The  control  design  presented  in  this  section  is  referred  to  as  IGC  Design  1 .  In  Section  IV,  the  control  designs  for  the 
azimuth  channel  and  for  maintaining  turn  coordination  are  modified  to  compensate  for  a  drawback  in  IGC  Design  1 
that  causes  unacceptably  large  sideslip  angles  during  turning  maneuvers.  The  modified  design  in  this  section  is 
referred  to  as  IGC  Design  2.  In  Section  V  the  results  of  simulation  and  their  discussion  are  given.  Section  VI 
presents  the  conclusions. 


II.  LOS-based  Formation  Flight  for  UAVs 

The  objective  of  the  formation  flight  experiment  will  be  for  the  follower  aircraft  to  maintain  a  prescribed  relative 
position  from  the  leader  aircraft  in  the  presence  of  leader  maneuvers  and  other  unmodeled  disturbances.  No 
communication  between  the  UAVs  is  assumed.  The  follower  UAV  is  equipped  with  just  one  fixed  camera  for 
passive  sensing  of  the  LOS  information.  The  complete  closed-loop  system  is  summarized  in  the  block  diagram  in 
Fig.  1. 

The  Image  Processing  and  Computer  Vision  block  takes  as  input  the  image  frames  from  the  onboard  camera  and 
processes  them  in  real-time  for  visual  tracking  of  a  target  (leader)  aircraft.  This  block  utilizes  the  method  of 
geometric  active  contours  1,16  to  track  various  features  of  interest  in  the  image  frames  over  a  period  of  time.  Active 
contours  have  the  ability  to  conform  to  various  object  shapes  and  motions,  making  them  ideal  for  segmentation, 
edge  detection,  shape  modeling  and  visual  tracking.  Level  set  methods  allow  for  fast,  robust  implementations  of  the 
active  contours  algorithms  U6. 

For  the  purposes  of  formation  flight,  the  IGC  block  needs  estimates  of  range  and  LOS  angles  between  the  leader 
and  follower  to  compute  commands  to  the  control  effectors  of  the  follower.  While  the  LOS  angles  are  available  from 
the  images,  the  range  is  not.  To  estimate  range  from  angle  measurements,  various  implementations  of  an  EKF  are 
possible  U7,  and  could  be  augmented  with  an  adaptive  element  for  robust  estimation  in  the  presence  of  unmodeled 
dynamics  and  disturbances  ls.  At  this  stage  we  have  not  integrated  the  image  processing  and  estimation  to  our 
integrated  guidance  and  control  algorithm.  Presently,  we  are  using  the  true  values  of  the  range  and  LOS  angles.  An 
approximate  differentiator  operates  on  LOS  angles  to  provide  estimates  of  LOS  angle  rates  3. 


Figure  1.  Closed-loop  UAV  System  for  LOS-based  Formation  Flight 
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III.  Integrated  Guidance  and  Control  using  Neural  Networks  -  Design  1 

This  section  presents  an  adaptive  approach  to  IGC  design  for  LOS  based  formation  flight.  We  formulate  the 
problem  as  an  adaptive  output  feedback  control  problem  for  a  leader-follower  formation  flight  configuration. 

A.  Line-of-Sight  (LOS)  Variable  Dynamics 

The  spherical  coordinates  consist  of  the  range  ( R  )  to  the  leader,  azimuth  angle  (  Aa  )  from  the  inertial  X-axis  to 
the  projection  of  the  LOS  vector  onto  the  X-Y  plane,  and  elevation  angle  ( AE  )  to  the  horizontal  (inertial  X-Y  plane). 
These  variables  are  given  in  terms  of  the  components  of  the  LOS  vector  in  the  inertial  frame  in  Fig.  2,  which  is 
basically  an  Earth-surface  fixed  frame. 


R  —  \l r\  +  Ry  "t-  Rz 


A  a  =  tan 


r  Ry  A 


\RXJ 


AF  =  tan- 


- R , 


^Rx+Rr 


The  inertial  frame  components  of  the  LOS  vector  are  given  in  terms  of  the  spherical  coordinates  as 

Rx  =  RcosAjcosA£ 

RY  =  Rs'mAA  cos/tg 


R7  =  -i?sinTt 


(1) 

(2) 

(3) 

(4) 

(5) 

(6) 


— ► 

X E(north) 


■V  Z E(down) 

Figure  2.  Inertial  Coordinate  and  Spherical  Coordinate  of  Line-of-Sight  (LOS) 
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By  differentiating  Eq.(l)  with  respect  to  time  and  utilizing  Eq.(4)-(6),  we  can  obtain  the  range  dynamics 

R  =  RxcosAAcosAE+RYsinXAcosAE-RzsmAE  (7) 

After  taking  tangent  on  both  sides  of  Eq.(2)  and  (3),  we  can  obtain  the  LOS  angle  dynamics  by  differentiating  and 
utilizing  Eq.(3)-(6) 


XE  - 


XA  =  - (-7?^  sin/1,4 cos/l^ ) 

R  cosAE 

-(/?y  cosAa  sinXE  +RY  sinAA  sinAE  +  Rz  cosAE 


(8) 

(9) 


where  Rx  ,Ry  ,Ry  denote  the  relative  velocity  components  between  the  leader  and  follower  aircraft  expressed  in 
the  inertial  coordinate  system,  which  are  related  to  range  rate  and  LOS  rate  as  follows: 


Rx  =  R cosAa  cosAe  -R/ lA  sinAA  cosAE  -R/ lE  cosAa  sinT.^ 


(10) 


Ry  =  7)sin/l^  cos/l^ +^/l^  cos/l^  cos/l^ sin/l^  sin/l^ 


(11) 


Rz  =  -RsinAE -RAE  cosAj. 


(12) 


By  differentiating  Eq.(7)-(9)  and  utilizing  Eq.(10)-(12),  we  obtain  the  following  relation  between  the  relative 
accelerations  and  the  second  time  derivatives  of  the  range  and  LOS  angles: 


•9  9  '2 

R  =  R\Aa  cos-  Aa  +  Ae  J+  \aX[  cos  Aa  cos/lE  +  aYi  sinAA  cosAE  -aZj  sin/L£ 


(13) 


A  A  =  - 


cos  A  l 


-22, 


' R^ 


COS  Air  —  Av  sill/^/: 


+  ^  j[-  aX,  sin  Aa  +  aYj  cos  Aa  ]|  (1 4) 


Ae  -  -2| 


\AE  - ArAsinAEcosAE -\  —  '\cix  cosAAsinAE+aYsinAAsinAE+az  cosAE 


(15) 


where  aXj  =  <*lx  ~aFx  aYj  =  aLY  ~~aFy  =%,  azt  =aLz  ~aFz  =  ^Z  are  the  relative  accelerations  of 

the  leader  with  respect  to  the  follower  in  the  inertial  plane.  Subscripts  ‘L’  and  ‘F’  denote  leader  and  follower  aircraft, 
respectively. 

B.  Control  Formulation 

The  standard  form  of  the  equations  of  motion  used  for  describing  formation  flight  can  be  written  as 


x  =  f(x,aL)  +  'Y_lgi(x)ui  and  y  =  h(x) 


(16) 


i=l 


where  state  vector :  x  = 


=  U  V  w 


p  q  r  ®  ©  'F  R  Aa  Ae  R  Aa  Ae  I  , 


_  -IT1  _  A 

input  vector:  u  =[  ST  Sa  5e  Sr  ,  u(t)eR 
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output  vector  :  y  =  [/?,  XA -VF,  XE -©,  <h]r,  y(t)eR 4 
leader  motion  state  vector:  dL  =  ’aLYl  ’aLZj  \ 


The  vector  [t/  F  W]T  is  the  translational  velocity  along  the  body-fixed  axes,  [p  q  /']  T  is  the  angular  velocity 

vector,  [<D  ©  A>] T  is  the  vector  of  Euler  attitude  angles,  and  the  vector  aL  consists  of  the  leader  acceleration  terms. 
Eq.(16)  is  composed  of  the  conventional  6  DOF  aircraft  dynamics  and  the  LOS  dynamics  in  Eq.(7)-(9)  where 
{  ST  Sa  8e  Sr  }  represent  throttle,  aileron,  elevator,  and  rudder  deflections  as  control  variables,  respectively. 

The  objective  of  the  control  law  design  is  for  the  follower  aircraft  to  maintain  a  prescribed  range  to  the  leader 
aircraft  in  the  presence  of  leader  maneuvers  and  other  unmodeled  disturbances.  In  the  formulation,  the  output 

variables  to  be  regulated  are  chosen  as[ft,  X A  -  'F.  XF  -  0.  <I>] T  .  The  bank  angle  <t>  command  is  constructed  to 
maintain  turn  coordination,  that  is,  to  nullify  the  side  acceleration  along  the  Y-axis  of  the  body  fixed  frame.  The 
range  command  is  given  by  a  constant  value,  which  is  chosen  as  the  length  of  two  wing  spans  in  the  examples  that 
follow.  The  variables  Xa  =  A  a  -  'P  and  Xe  =  ®  represent  the  bearing  angles  in  the  camera  image  plane.  The 

bearing  angle  rate  commands  are  set  to  zero.  The  bearing  angles  are  not  regulated  since  it  is  not  desirable  to  restrict 
the  follower  aircraft  to  a  particular  orientation  with  respect  to  the  leader  aircraft,  particularly  in  the  presence  of 
leader  maneuvers. 


1 .  Relative  Degree  and  Approximate  Feedback  Linearization 

To  show  the  existence  of  a  well-defined  vector  relative  degree,  the  output  variables  are  differentiated  until  the 
control  variables  appear.  The  first  step  in  this  direction  is  to  transform  the  follower  acceleration  terms 
pF  ,0c  ,oe-  (,  in  Eq.(13)-(15)  in  the  inertial  frame,  into  the  follower  body-axes  coordinate  frame.  It  is  also 

preferred  to  use  the  specific  force  vector  in  the  body-axes  coordinate  frame  instead  of  the  acceleration  vector,  since 
the  specific  force  vector  is  a  directly  measured  quantity.  This  is  accomplished  by  first  subtracting  the  gravity  vector. 


- 

f 

- 

X 

apxB 

apx, 

0 

aprB 

=  Z.r(<D)Zv(©)Z=m- 

apn 

- 

0 

apZB_ 

K 

apzi  _ 

_g_ 

/ 

which  implies, 


apx, 

apxB 

"0" 

apn 

=  Zz  (-VF)Z  v  (-©)ZV  (-<t>) 

apyB 

+ 

0 

apzi  _ 

apZB  _ 

_g_ 

(17) 


(18) 


In  Eq.  (17),  (18)  the  variable  L  represents  a  rotation  matrix  and  the  subscript  indicates  the  axis  about  which  the 
rotation  occurs.  The  terms  { a /.- ,  ,aF  ,aF  }  are  measurable  acceleration  components  in  the  body  fixed 

coordinates  and  will  be  used  in  feedback  loop  in  the  controller.  It  is  assumed  that  only  the  X-component  of 
{aF  .  ,aF  ,aF  }  has  a  functional  relation  to  the  throttle  among  the  control  input  variables  {FT ,5a, Se,  5r}  of  the 

x  b  ^b  Zg 

follower  aircraft.  The  Y-  and  Z-components  are  assumed  to  be  independent  of  the  control  input  variables  since  their 
dependency  is  secondary.  Thus 


~apX% 


+  A  ci  i 


lxB 


(19) 
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where  aF  =  13^.  +3r.  )/ m  ,  A  aF  =  (A3^  +  A3r  )lm  =  ■••  +  Xgp -8T  ,  where  3  refers  to  the 

X Bo  '  -^0  Xq  /  Xg  '  X  X  n 

external  force  acting  on  the  aircraft,  and  the  variables  3  A ,  3r  refer  to  the  external  force  due  to  aerodynamics  and 
thrust  respectively.  Combining  Eq.(18)  and  (19)  into  Eq.(13)-(15),  we  obtain 


’  R~ 

-  cos)1?  -  XA )  cos  XE  cos  ©  -  sin  XE  sin  © 

XA 

= 

+ 

-sin)®  -XA ) cos &/R  cosAE 

Aae_ 

{cos)1?  -  Aa  )  sin  Ae  cos  ©  -  cos  AE  sin  @J/R 

(20) 


where  the  vector  [a^,A^,A^]?  is  a  function  of  the  LOS  variables,  the  leader  acceleration  terms,  and  the 
follower  aircraft  motion  variables. 

The  next  step  is  to  obtain  the  time  derivatives  of  the  Euler  angles  *?,  0  and  ®  in  terms  of  the  remaining  control 
effectors.  To  do  this,  first  consider  the  relationship  between  the  Euler  angle  rates  and  the  angular  velocities  21 , 

6=p  +  (q  sin® +  rcos®)tan@ 

©  =<7COS®-rsin®  (21) 

*?  =  (<7  sin®  +  rcos®)sec@ 

and  thus  the  second  time  derivatives  of  Euler  angles  {®,  ©.  'F  j-  can  be  expressed  in  the  form: 


®  =/>  +  (<)sin®  +  r  cos®)tan©  +  A<j, 

©  =  geos®  -r  sin®  +  A@  (22) 

®  =  (gsin® +  f  cos®)sec©  +  A«j< 

where  {a^Aq,  Aip}  are  functions  of  the  angular  velocities  and  Euler  angles.  The  derivatives  of  the  angular 
velocities  {p,  q,  depend  mainly  on  the  control  surface  perturbations  {Sa,Se,5r} , 


p  = 

:)  +  Lfo  ■  Sa 

q  =  Aq(x 

)  +  M  Se  '  & 

(23) 

r  =  Ar(x 

)  +  X  gr  ■  Sr 

where  \a  p,Aq,  Ar  ]  are  functions  of  the  states  of  the  aircraft  dynamics.  Using  Eq.(23)  in  Eq.(22),  we  obtain: 


®  =  AJj,(x)  +  •  da  +  sin  ®  tan  ©  •  §e  +  N cos  ®  tan  ©  •  Sr 

©=  A'0(x)  +  M$,  cos®  -Se- Nfr  sin  ®  •  Sr 

NK  =  A'vy  (x)  +  M&  sin  ®  sec  ©  •  Se  +  N$.  cos  ®  sec  ©  •  Sr 


Thus,  we  have  the  following  relations 


R 

ST 

: 

1 

: 

A  (x,aL,t) 

+ 

A(x) 

Sa 

bl 

1 

© 

Se 

® 

Sr 

(24) 


(25) 


where 
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-  Xdr  {cos(vF  -  XA )  cos A,e  cos©  +  sin  A,E  sin©}  0  0 

-Xgj'  sin(vP  -  2^ )  cos  0/7?  cos  0  -M&  sin <5  sec© 

Xdr  {cos(vF  -  XA  )  sin2,£  cos  ©-cos If-  sin©}/7?  0  -M&  cos® 

0  L&  M  fe  sin  <6  tan  0 

A  well-defined  vector  relative  degree  15  exists  if  and  only  if  A(x )  is  non-singular.  Its  determinant  is  given  by 

det  A(x)  =  X gpLfaM aN ^.{cost1?  -  Aa)cosAe  +  sin/t£  tan©}  (27) 

Since  we  regulate  range,  bank  angle  and  the  bearing  rates,  the  system  has  a  well-defined  vector  relative  degree 
{2, 1,1, 2 }  unless  the  quantity  in  braces  is  zero. 

The  process  of  dynamic  inversion  ignores  the  nonlinearities  and  leader’s  acceleration  terms  in  Eq.(24).  Thus,  an 
approximate  feedback  linearization  is  given  as  follows: 


where  the  vector  v  =  v<t>  ]  T  represents  the  pseudo-control  input  vector  and  represents  the  desired 

dynamics  of  the  output  vector  [/?,  X A  -  'F.  i E  -  0,  <h] 1  .  Thus,  the  system  dynamics,  as  far  as  the  regulated  output 
variables  are  concerned,  from  Eq.  (25)  and  (28),  is  given  by 

j?W=  A  +  v 

where  =  [/?  X^—'V  XE-&  4)]^  ,  where  r  =  {2, 1,1, 2}  is  the  vector  relative  degree  and  A  =  A  (x,dL,t)  is  the 
modeling  error  vector  consisting  of  the  LOS  variables,  leader  acceleration  terms  and  follower  aircraft  motion 
variables. 

The  bank  angle  command  is  constructed  to  maintain  turn  coordination,  that  is,  to  nullify  the  side  acceleration 
along  the  Y-axis  of  the  body  fixed  frame.  This  can  be  accomplished  in  several  ways.  One  such  way  is  to  use  a  PD 
controller  to  regulate  the  side  acceleration  to  zero  as  in  Fig.  3. 

2.  Controller  Design  using  Adaptive  Output  Feedback 

The  objective  of  the  control  design  is  for  the  output  vector  y  =  [/?  XA-'¥  XE  —  0  d)]7  to  track  a  stable,  bounded 
reference  trajectory  vector  yc  .  The  pseudo-control  is  chosen  to  have  the  form  13-14 

j7  =  y[r>  +  Vdc  ~  vad  (29) 


0 

-  N x,.  cos  d>  sec  0 

*  •  ^  (26) 
N a.  sm  d> 

N a.  cos <6  tan© 
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where  yjf\  the  rth  derivatives  of  the  reference  trajectory  vector  yc  ,  are  generated  by  stable  reference  models  that 
define  the  desired  closed-loop  behavior,  vdc  is  the  vector  output  of  linear  dynamic  compensators  designed  to 
stabilize  the  linearized  error  dynamics,  and  vad  is  the  vector  adaptive  component  designed  to  cancel  the  effect  of 
the  modeling  error  vector  A  . 

Since  range  has  relative  degree  2,  the  plant  transfer  function  from  the  pseudo-control  vR  to  R  is  1/52  .  A  first 
order  lead-lag  compensator  structure  was  selected  to  stabilize  the  range  eiror  dynamics  according  to  the  direct 
adaptive  output  feedback  approach  of  Ref.  [13].  In  addition,  the  pole-placement  approach  was  used  to  satisfy  the 
SPR  condition.  The  resulting  two  outputs  of  the  compensator  are  given  by 


vdcR 

i 

"8(5  +  1) 

y adR 

~  s  +  l 

20(5  +  1) 

■yR(s) 


(30) 


which  places  the  closed-loop  poles  of  the  error  dynamics  at  -3, 


- 1  +  j  .  The  low  pass  filter  TR 1  (s )  was  chosen  as 


Tr(s) 


1 

0.5s +  1 


(31) 


It  is  easy  to  verify  that  the  transfer  function  G R(s)TR(s)  is  SPR.  A  Sigma-Pi  (SP)  NN  with  47  neurons  and  a  bias 
term  was  used  in  the  adaptive  element.  The  aircraft  motion  variables  \(J ,  V,  W,  p,  q,  r,  ®,  ©,  T]  T  ,  the  LOS 
kinematics  variables  \R,z Ia,Ar]T  ,  the  current  pseudo-control  input  vR  ,  and  the  training  signal  from  the 
compensator  ya(jR  ,  were  used  in  the  input  vector  to  the  neurons.  All  the  NN  inputs  were  normalized  using  an 

estimate  for  their  maximum  values.  The  complete  input  vector  consisted  of  these  values  together  with  a  bias  term. 
Thus,  there  are  a  total  of  48  NN  weights.  The  NN  gains  were  set  to  FR  =  50  and  AWr  =  1.  Range  was  commanded 

to  follow  the  output  of  a  second  order  reference  model,  designed  with  a  natural  frequency  of  a>ltR  =  1  rad/sec  and 

damping  $-s=0.8. 

Since  the  bearing  angle  rates  Za  and  Ze  are  relative  degree  1  outputs,  the  linear  compensators  corresponding 
to  these  outputs  are  just  proportional  error  controllers.  The  gains  of  the  proportional  error  controller  were  chosen  as 
Kx  i  =  10  and  =  10.  Thus,  their  designs  follow  a  state  feedback  approach,  and  the  tracking  error  of  the  bearing 

angles  rates  are  directly  used  as  training  signals  for  the  NN.  The  command  filter  was  chosen  as  a  first  order  system 
with  time  constants  of  =tXe=1.  The  NN  used  in  each  channel  has  the  same  form  as  in  the  range  channel 

except  for  the  input  vectors  \’yA ,  yady  and  \’%e  ’  ^adxE  J  ^  an<J  the  network  gains  of  =100,  =  0.5  and 

^Xe  ~  I®®,  ^wXE  -  0-5- 

The  bank  angle  command  ®  com  in  Fig.  3  is  filtered  through  a  second  order  command  filter  to  generate  the 
reference  bank  angle  command  <1>C.  Since  the  bank  angle  has  relative  degree  2,  a  first  order  lead-lag  compensator 
structure  was  selected  to  stabilize  the  bank  angle  error  dynamics.  By  using  pole-placement  to  satisfy  the  SPR 
condition,  the  resulting  two  outputs  of  the  compensator  are  given  by 


vdc0 

1 

"8(5  +  1) 

_y ad®  _ 

_  5  +  10 

20(5  +  1) 

•To  00 


(32) 


which  places  the  closed-loop  poles  of  the  error  dynamics  at  -3, 


- 1  +  j  .  The  low  pass  filter  T’o1  (s)  was  chosen  as 
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1 


(33) 


T^(s) 


0.55  +  1 


so  that  the  transfer  function  G^{s)T(^{s)  is  SPR.  A  Sigma-Pi  (SP)  NN  with  47  neurons  and  a  bias  term  was  used  in 

the  adaptive  element.  The  variables  \j,V,  W,P,  Q,R,Q>,  ©,  ,  Tg ,  v<j> ,  yad<t>  ]  T  were  used  as  inputs  to  the 

NN.  All  of  the  NN  inputs  were  normalized  using  an  estimate  for  their  maximum  values.  The  complete  input  vector 
consisted  of  these  values  together  with  a  bias  term.  Thus,  there  are  a  total  of  48  NN  weights.  The  network  gains 
were  F([)  =  100  and  =  1.  The  bank  angle  was  commanded  to  follow  the  output  of  a  second  order  reference 

model,  designed  with  a  natural  frequency  of  03n<b  =  5  rad/sec  and  damping  g#  =0.8. 

The  NN  adaptation  rule  for  each  channel  is  given  from  the  extensions  of  Lyapunov  theoiy  20 


W  =  -F^adtf+Xww) 


(34) 


where  F  >  0  and  >  0  are  the  adaptation  gains  and  (j)  f  is  the  basis  function  vector  (j>  after  being  filtered  through 
r^Os) .  Fig.  4  shows  a  block  diagram  implementation  of  the  controller  design. 

3.  Pseudo-Control  Fledging  (PCFI) 

Any  dynamics  and  nonlinearities  associated  with  actuators  have  not  yet  been  considered  in  the  design.  If  the 
actuators  become  position  or  rate  saturated,  the  reference  models  will  continue  to  demand  tracking  as  though  full 
authority  were  still  available.  Furthermore,  when  an  adaptive  element  such  as  a  neural  network  is  introduced,  these 
actuator  nonlinearities  will  appear  in  the  tracking  error  dynamics  resulting  in  the  adaptive  element  attempting  to 
correct  for  them.  PCFI  is  introduced  to  protect  the  adaptive  law  from  effects  due  to  actuator  rate  and  position  limits, 
unmodeled  actuator  dynamics  and  to  protect  the  adaptive  process  when  it  is  not  in  control  of  the  plant.  The  main 
idea  behind  PCFI  methodology  is  to  modify  the  reference  command  in  order  to  prevent  the  adaptive  element  from 
adapting  to  these  actuator  characteristics,  while  allowing  adaptation  to  other  effects  to  continue.  This  is  commonly 
done  by  generating  the  command  using  a  reference  model  for  the  desired  response.  The  reference  model  is  ‘hedged’ 
by  an  amount  equal  to  the  difference  between  the  commanded  and  an  estimate  for  the  achieved  pseudo-control 19. 
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KL 


Figure  4.  Integrated  Guidance  and  Control  Logic  Block  Diagram  for  Follower  Aircraft  -  Design  1 

4.  Remark 

The  IGC  design  developed  above  leads  to  unacceptably  large  sideslip  angles  as  will  be  shown  in  the  simulation 
results.  The  problem  here  can  be  noticed  by  examining  the  first  three  rows  of  Eq.  (25)  and  the  matrix  A(x )  in  Eq. 

(26).  It  can  be  seen  that  the  derivatives  R  ,  Aa  — 'F  and  AE  —  ©  do  not  contain  the  aileron  deflection  term  8a  . 
Specifically,  the  term  Aj  -  *¥ ,  which  is  the  second  derivative  of  the  azimuth  bearing  angle  Aj  -  'F  .  shows  strong 
dependence  on  the  rudder  deflection  5r  for  small  bank  angle  <D  .  This  implies  that  the  rudder  is  used  to  generate  a 
heading  rate  to  regulate  the  azimuth  bearing  rate  to  zero.  Using  the  rudder  in  this  way  causes  uncoordinated  turns 
leading  to  unacceptably  large  sideslip  angles.  In  the  next  section,  the  azimuth  channel  is  redesigned  using  the 
approach  of  adaptive  backstepping  910  to  avoid  using  the  rudder  to  control  the  azimuth  rate. 

IV.  Integrated  Guidance  and  Control  using  Neural  Networks  -  Design  2 

The  idea  behind  the  redesign  of  the  azimuth  channel  is  to  show  that  there  exists  a  natural  dependency  of  the 
azimuth  rate  derivative  Aa  on  the  bank  angle  <f> ,  and  consequently  on  the  aileron  deflection  8a .  Then  this  natural 
dependency  can  be  exploited  in  a  strategy  to  implement  adaptive  backstepping  in  terms  of  three  feedback  loops  as 
follows 

(A A)  ->  (0  ->  ip)  (&) 

A.  Azimuth  rate  control  via  backstepping  design 

The  first  step  is  to  re-write  Eq.  (14)  as  follows 
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Figure  5.  Coordinate  Reference  Frames  in  Florizontal  Plane 


XA  - 


cosAe 


\RJ 


R  cos  dp 


-  aLxi  sin  Aa  +  aLyj  cos  4,  -  (-  aF^  sin  4,  +  aFy/  cos  4,) 


where  aFr  and  aF 

Xj  Yj 


tx  aFy  represent  the  X  and  Y-axis  acceleration  components  of  follower  aircraft  expressed 
Cartesian  inertial  coordinates,  respectively.  Then  the  following  equality  can  be  derived 


~aFXl 


sin  Aa  +  ci Fy  cos  A, a  —  ~  ® 


sin  (.4  -  XP)  +  aF  cos(4  -  T ) 


in  the 


(36) 


where  aFy  and  aFy  represent  the  X  and  Y-axis  acceleration  components  of  follower  aircraft  expressed  in  the 

coordinate  frame  obtained  by  a  rotation  about  the  inertial  Z-axis  by  the  Euler  angle  'P  .  From  the  pictorial 
representation  of  the  coordinate  frames  in  the  inertial  horizontal  plane,  the  acceleration  component  aFy  can  be 

approximated  as  follows 


ap .  COS0-TV  ~VF  cos 


©(T/  +  y0) 


(37) 


where  the  subscript  ‘W  indicates  the  wind  axes.  Then,  the  following  identities  can  be  used  to  expand  Eq.  (37) 

¥  =(<7sin<l>  +  rcos<l>)sec©  (38) 


P  =  p  sin  a  -  r  cos  a  +  — - —  ( D  sin  fi  +  Y  cos  0) 
mVF 

+  -y—  (cos  a  sin  P  sin  ©  +  cos  P  sin  O  cos  6  -  sin  a  sin  P  cos  <S  cos  ©) 


(39) 
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Eq.  (35)  can  be  re-written  as  follows  by  utilizing  Eq.  (36)-(39) 


&  A  =  f\(x)+  g\(x)-<&  +  t±lA{x,aL) 


(40) 


where 


2A*a 

''r' 

cos  Ae  -Xe  sin  Ae 

r  1  ^ 

cos  Ae 

.v R ) 

v7?cosA£ 

gi(*)  =  -C°!(^  yV){vF  q  +  g cosy? cos2  ©) 
RcosAe 


sin  (A  a  -vf) 


(41) 


are  known,  computable  terms.  We  also  have 

®  =fi^)+S2P  >/2(^)  =  (?sin®  +  '‘cosO)tan©,  g2  =1  (42) 

P  =  Mx)+g3Sa  +  Ap(x,&i),f3(x)  =  Lvv  +  Lpp  +  Lrr  ,  g3  =  L<h  (43) 

where  /2(x),  f3(x),  g2,g3  are  known,  computable  terms.  Eq.(40)-(43)  show  that  the  azimuth  rate  dynamics  has  a 
natural  cascade  form.  That  is,  <j>  can  be  used  as  a  virtual  control  for  the  Aa  dynamics,  and  p  as  a  virtual  control 
for  the  <j>  dynamics,  with  the  control  5a  finally  being  computed  to  ensure  Aa  command  tracking. 
LetXj  =  j  x2  =  </>■>  x3  =  Pi  and  u=5a  .  Then  Eq.(40)-(43)  can  be  rewritten  as  follows: 


x\  =  f\ (x)  +  gi  (x)x2  +AXa  (x,  aL ) 

(44) 

x2  =  fl  (X,X2  )■*■•*•  3 

(45) 

x3  =  /3  (*>  X3)  +  S3u  +  Ap  (x, &) 

(46) 

where  Ax  and  A  p  are  modeling  error  terms  and  are  functions  of  the  states  of  the  system  x  shown  in  Eq.  (16),  the 

leader  acceleration  terms  a  L ,  and  the  control  deflection  5a  . 

With  the  plant  dynamics  cast  in  the  proper  form,  an  adaptive  backstepping  method  is  presented.  We  begin  by 
defining  the  following  error  states 

Cl  =  xlc  ~X1  (47) 

Ci=  g\-(x2~x2)  (48) 

C3  =  gl  '(*3  -^3)  (49) 


where  X2  and  x3  are  virtual  commands  to  be  constructed  that  will  ensure  that  the  command  Xj  is  tracked. 

Step  1:  Differentiating  <^1  of  Eq.(47)  and  applying  Eq.  (44)  and  (48)  yields 

Cl  =  x\c  -X]  =  xic  ~f\  ~  g\x2  ~A\  =  xjc  -/,  +  C2  -gxx2  ~  A xA  (50) 
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where  x2  *s  viewed  as  a  virtual  control  for  the  C\  dynamics.  Then  to  stabilize  Eq.  (50),  let 

X2  =  S\  X\K\G\  -  f\  +X\C  ~vad\  (51) 

where  vad ■  is  an  adaptive  control  term  designed  to  cancel  .  Then  substituting  Eq.(51)  into  Eq.(50)  yields 


Cl  -  -  KlCl  +  Cl  +  vad ,  ““  A1 


(52) 


where  Aj  =A^  .  In  ideal  conditions,  vad ■  =  A\  and  x2  — >  x2  ,  so  the  error  £2  0  ,  and  the  fi  dynamics 

become  asymptotically  stable. 


Step  2:  Differentiating  C2  yields 


Cl  =  gl(x2-x2)+gl[x2-x2)  =  gl(x2-X2)+glX2-glX2 
=  -A2  +X\  -g\X2  -g\f2  =  -A2  +  Xi  -gif 2  +  C3  _gl*3 


(53) 


where  A2  =  -[gi(x2  ~x2)+g1x2  -X\  ]  since  the  derivatives  of  f\  and  gj  contain  unknown  terms  due  to  leader 
aircraft  motion.  Let 


*3  -  g\  l\f\  +K2C2  +X\  -g\f2  ~vadi  . 


(54) 


so  that 


Cl  -  -  Cl  -  KlCl  +  Cl  +  vadn  -  A2 


(55) 


The  purpose  of  introducing  in  Eq.(55)  is  to  compensate  for  the  coupling  between  the  and  f2  dynamics.  The 
sign  of  the  C\  in  Eq.(54)  is  intentionally  chosen  as  negative  to  set  up  a  skew-symmetric  matrix  representing  the 
complete  error  dynamics.  This  skew-symmetric  structure  is  a  key  feature  of  backstepping  controllers,  and  results  in 
the  cancellation  of  the  coupling  terms  during  Lyapunov  stability  analysis  10. 

Step  3:  This  last  step  is  very  similar  to  the  previous  ones  except  that  rather  than  the  virtual  control,  the  actual  control 
signal  is  constructed.  Differentiating  yields 


C3  =  g\{x3  -X3)+g\(x3-X3)=  gi^-x^+giXi-gik?, 

=  gl{x3  ~x3  )+  gl*3  ~  g  1  if 3  +g3u  +  ^p)  =  _A3  +Xl  -£1/3  ~glg3u 


where  A3  =  -|gl(*3 -*3)  +  gl*3 -giA^J.  Let 


u  = 


U1&3)  1  Cl  +  ^3^3  ~  g I fl  +  X\C  ~vad3. 


so  that 


(56) 


(57) 


Cl  -  -  Cl  -  KlCl  +  vad,  _  A3 


(58) 
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kl  /£ 

j?  -  A j\  should  be  kept  less  than  — .  The  control  power 

g 3  =  Lfa  remains  non-zero  in  most  aircraft  control  applications.  Eq.(52),  (55),  and  (58)  can  be  now  expressed  in 
state  space  form 


z-Az  +  vad  “A 

where  z  =  [cu  ^2>  Cl  F>  vad  =  Vad^  vad2’  vadi  [At,  A2,  A3  Y ,  and 


A  = 


-Kx  1 

-1  -Ki 


0  -1  -  Ki 


(59) 


(60) 


The  gains  Kx  2  3  >  0  to  ensure  stability,  but  they  also  need  to  be  tuned  to  obtain  reasonable  performance.  The 

complete  control  policy  is  given  by  Eq.(51),  (54),  and  (57).  The  block  diagram  for  this  control  structure  is  given  by 
Fig.  2.  The  detailed  proof  of  stability  of  closed-loop  system  and  the  derivation  of  the  adaptation  law  are  referred  to 
Ref.  [9]  and  the  references  within. 

B.  Turn  Coordination  -  Adaptive  side  acceleration  control 

To  maintain  turn  coordination,  the  side  acceleration  along  the  y-axis  of  the  body-fixed  frame  aYlj  is  regulated  to 

zero.  The  control  design  consists  of  an  outer-loop  proportional-integral  (PI)  controller  acting  on  the  side  acceleration 
command  error  and  whose  output  zcom  is  a  command  for  the  blended  output  z  =  J3  +  Crr  22 .  The  signal  zcom  is 
input  to  an  inner-loop  inverting  controller  augmented  by  an  adaptive  NN  that  generates  rudder  deflection 
command  Srcom  .  The  details  of  the  design  are  contained  in  Ref.  [22]. 


vad 3 

Figure  6.  Control  Structure  of  LOS  Azimuth  Angle  Channel  using  Adaptive  Backstepping  Algorithm 
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Figure  7.  Side  acceleration  controller 


C.  Dynamic  Inversion 

From  the  modified  design  for  azimuth  rate  control  and  turn  coordination  above,  the  equation  for  dynamic  inversion 
to  determine  the  actuator  deflection  commands  can  be  set  up  as  follow 


(61) 


where 


A2(x)  = 


~  —  X  gr  |cos(vP  —  Aa  )  cos/t^  cos©  +  sinl£  sin©}  0 

0  gl(*)&3 

{cosOP -2,,)  smXE  cos 0- cos  sin@}/ft  0 


-Mg,  cos N Sr  sin  cD 

0  ^  +  CrNSl. 

uo 


where  Uq  is  the  trim  speed  of  the  aircraft,  the  value  for  C;.  can  be  obtained  by  following  the  design  procedure  in 
Ref.[22],  and  A2  (x,  a / ,  t)  is  the  modeling  error  vector  different  from  the  one  in  Eq.  (25).  Thus,  an  approximate 
feedback  linearization  is  given  as  follows: 

ST 
Sa 
Se 
Sr 

where  the  vector  v  =[vs  v ^  vz]r  represents  the  pseudo-control  input  vector  and  represents  the  desired 

dynamics  of  the  vector  [ft,  if  3 ,  A E  -  0,  z] 7  .  The  rest  of  the  control  design  is  very  similar  to  the  design  presented  in 
Section  III  B.2,  the  details  of  which  can  be  found  in  Refs. [13]  and  [14].  The  block  diagram  of  the  overall  system  is 
shown  in  Fig.  8. 
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Figure  8.  Integrated  Guidance  and  Control  Logic  Block  Diagram  for  Follower  Aircraft  -  Design  2 


V.  Simulation-Based  Evaluation 

A.  Time-Scale  Separated  Guidance  and  Control  (TSSGC)  Design 

The  TSSGC  design  is  described  in  complete  detail  in  Ref.  [3].  This  section  just  provides  a  summary.  The 
TSSGC  design  consists  of  an  outer-loop  guidance  block  that  takes  as  inputs  range  and  LOS  rate  commands.  With 
feedback  of  LOS  variables  and  their  derivatives,  and  the  follower  aircraft  kinematics  state  information,  the  guidance 
block  computes  inertial  acceleration  commands  by  carrying  out  approximate  dynamic  inversion  of  the  range  and 
LOS  rate  kinematics.  The  inertial  acceleration  commands  are  transformed  into  normal  )  and  longitudinal 

specific  force  commands,  and  a  bank  angle  command.  These  commands  along  with  a  side  acceleration 

command  of  zero  are  sent  to  an  inner-loop  autopilot.  The  autopilot  consists  of  dynamic  inversion  based  controllers 
for  normal  and  side  acceleration  command  tracking,  and  bank  angle  command  tracking,  plus  a  PI  throttle  controller 
for  tracking  a  blend  of  the  longitudinal  acceleration  and  speed  command  Vcom  .  NN  based  adaptation  is  introduced 
in  the  guidance  block  to  compensate  for  modeling  error  due  to  unknown  leader  aircraft  acceleration.  NN  based 
adaptation  is  also  introduced  in  the  autopilot  to  compensate  for  modeling  error  due  to  parametric  aerodynamic 
modeling  uncertainties. 

B.  Simulation  Results 

A  nonlinear  6-DOF  simulation  with  linearized  aerodynamics  is  used  for  the  testing  of  the  control  and  guidance 
algorithms  for  formation  flight.  Quaternion  attitude  angles  are  obtained  by  integrating  the  rate  gyros.  The  simulation 
model  is  a  rigid  body  aircraft  model  with  13  states,  3  for  position  with  respect  to  the  Earth-fixed  frame,  3  for 
translational  velocity  expressed  in  the  body  frame,  4  for  the  quaternions  and  3  for  the  angular  velocity  expressed  in 
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the  body  frame.  Engine  thrust  is  obtained  from  a  linear  interpolation  map  of  throttle  position.  The  actuators  are 
modeled  as  first-order,  stable  linear  filters  with  rate  and  position  limits  and  time  delays. 

The  IGC  Design  1,  IGC  Design  2,  and  the  TSSGC  Design  are  evaluated  on  the  basis  of  tracking  a  commanded 
range  from  a  maneuvering  leader  aircraft.  The  commanded  range  is  5  meters,  which  is  approximately  two  wing-span 
lengths  of  the  follower  aircraft.  The  LOS  (bearing)  rate  commands  for  the  TSSGC  (IGC  1  and  IGC  2)  are  nominally 
set  to  zero.  In  case  the  bearing  angles  drift  to  values  greater  than  the  field-of-view  maximum  widths,  which  are 

assumed  to  be  ±30°  for  both  the  azimuth  and  elevation  bearing  angles,  the  LOS  (bearing)  rate  commands  are 
adjusted  to  keep  the  bearing  angles  within  ±  30°  . 

The  leader  maneuver  is  a  3D  slanted-box  maneuver  as  shown  in  Fig.  9.  The  commanded  speed  of  the  leader 
aircraft  is  Vcom  =  25  meters/sec.  The  guidance  and  control  design  for  the  leader  aircraft  is  the  TSSGC  design 
outlined  in  Section  V-A  above.  The  leader  starts  off  at  the  origin  (0,0,0)  and  moves  at  constant  velocity,  then  turns 
and  climbs,  turns  again  at  constant  altitude,  and  finally  turns  and  descends  to  the  starting  point.  All  the  results  below 
include  the  effect  of  adaptation.  In  the  absence  of  adaptation,  the  particular  leader  maneuver  chosen  results  in 
closed-loop  system  instability  of  the  follower  aircraft  with  all  the  three  guidance  and  control  designs.  This  shows  the 
vulnerability  of  the  designs  to  modeling  error  due  to  leader  accelerations  and  aerodynamic  uncertainties. 

Figures  10  a,  b,  and  c  show  the  range  command  tracking  performance  in  meters  with  the  TSSGC,  IGC  1  and  IGC 
2  designs.  The  black  solid  line  represents  the  commanded  range  Rcom  =  5  meters,  the  blue  dotted  line  is  the  range, 
and  the  red  dashed  line  represents  the  hedged  reference  signal.  The  range  signal  R  tracks  the  hedged  reference 
signal  Rrej ■ .  It  is  clear  that  the  performance  with  the  IGC  designs  (Fig.  10  b,  c)  is  superior  to  the  TSSGC  design  (Fig. 

10  a)  by  virtue  of  much  smaller  range  overshoots  (maximum  of  1.5  meters  for  the  IGC  designs,  versus  5  meters  for 
the  TSSGC  design)  from  the  commanded  range,  and  convergence  to  the  commanded  range  in  steady-state.  The 
overshoots  in  range  occur  after  the  leader  aircraft  starts  a  maneuver. 

One  of  the  reasons  for  the  deficient  performance  of  the  TSSGC  design  when  compared  to  the  IGC  design  is  the 
choice  of  command  to  the  throttle  controller  in  the  TSSGC  design.  The  throttle  controller  in  the  TSSGC  design  is  a 
PI  controller  with  anti-windup  feature  for  commanding  throttle  position  Sj  .  There  is  a  stability  issue  when  the 

longitudinal  acceleration  command  fx  from  the  guidance  law  is  input  to  the  throttle  controller  for  the  case  of  a 

sharply  turning  leader  aircraft.  This  is  due  to  the  fact  that  the  guidance  logic  generates  an  excessive  negative 
acceleration  command  along  the  X-axis  of  the  body  frame  (highly  negative  fx  )  when  starting  a  heading  turn  and 

this  causes  saturation  into  the  lower  bound  of  the  throttle,  ultimately  leading  to  instability  of  the  entire  closed-loop 
system.  The  same  reasoning  is  applicable  to  the  leader  aircraft.  So  for  the  leader  aircraft,  the  command  to  the  throttle 
controller  consists  of  only  the  speed  command  Vcom  ,  and  for  the  follower  aircraft,  the  throttle  controller  command 
is  modified  to  be  a  blend  of  the  longitudinal  acceleration  command  fx  and  speed  command  Vcom  as  in  Fig.  11, 
where  0  <  Kx  <  1  is  a  design  constant.  This  is  arguably  not  a  fair  evaluation,  since  the  follower  aircraft  cannot  know 
a  priori  the  commanded  speed  of  the  leader  aircraft  in  a  realistic  setting.  The  throttle  controller  command  in  Fig.  11 
reduces  the  transient  speed  of  response  of  the  range  variable  and  the  desired  steady-state  with  respect  to  range  is  not 
exactly  achieved  (Fig.  10  a),  even  when  the  leader  stops  maneuvering.  The  gain  Kx  has  to  be  chosen  carefully  and 
is  obtained  after  several  simulation  runs  for  different  leader  maneuvers,  to  get  acceptable  range  tracking 
performance  while  not  saturating  the  throttle  controller.  The  consequence  of  the  modification  of  the  throttle 
command  is  the  trade-off  between  range  command  tracking  and  closed-loop  stability  for  the  TSSGC  design.  This  is 
not  an  issue  in  the  IGC  designs  since  the  throttle  command  is  obtained  by  the  dynamic  inversion  of  the  range  and 
bearing  rates’  dynamics  (Eq.  28  and  Eq.  63)  with  adaptive  compensation  for  the  modeling  errors. 

Figures  12  a,  b,  and  c  show  the  LOS  and  bearing  rates  histories  in  degrees  per  second  with  the  TSSGC  and  IGC 
designs.  When  the  leader  maneuvers,  there  are  large  overshoots  in  the  LOS  and  bearing  rates  histories,  but  the 
overshoots  with  the  IGC  designs  are  much  smaller  than  those  with  the  TSSGC  design. 

Figures  13  a,  b,  and  c  show  the  actuator  deflections  with  the  TSSGC,  IGC  1  and  IGC  2  designs.  With  the  IGC 
designs,  there  is  lot  more  activity  in  the  rudder  and  aileron  channels  with  the  IGC  designs  than  with  the  TSSGC 
design. 

Figures  14  a,  b,  and  c  show  the  angle  of  attack  and  sideslip  angle  histories  in  degrees  with  the  TSSGC,  IGC  1 
and  IGC  2  designs.  It  is  clear  that  the  sideslip  angles  with  IGC  design  1  are  unacceptably  large  (maximum  15 
degrees).  With  the  TSSGC  design  and  IGC  design  2,  the  sideslip  angle  histories  are  acceptable  (maximum  4 
degrees). 
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Figure  9.  Leader  3D  slanted-box  Trajectory  (meters) 
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10  c 

Figure  10.  Range  Command  Tracking  (meters),  a)  TSSGC  Design,  b)  IGC  Design  1,  c)  IGC  Design  2 
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Figure  11.  Throttle  Controller  in  TSSGC  design 
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Figure  12.  LOS  and  Bearing  rates  Tracking  (deg/s),  a)  TSSGC  Design,  b)  IGC  Design  1,  c)  IGC  Design  2 
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Figure  13.  Actuator  deflection  histories  a)  TSSGC  Design,  b)  IGC  Design  1,  c)  IGC  Design  2 
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Figure  14.  Aerodynamic  Angles  (deg)  a)  TSSGC  Design,  b)  IGC  Design  1,  c)  IGC  Design  2 


VI.  Conclusions 

This  paper  has  presented  an  IGC  design  for  formation  flight  using  a  combination  of  adaptive  output  feedback 
and  backstepping  techniques  without  an  underlying  time-scale  separation  assumption.  The  design  objective  was  to 
regulate  the  range  and  two  bearing  angle  rates  with  respect  to  a  maneuvering  leader  aircraft  and  maintaining  turn 
coordination.  Neural  network  based  online  adaptation  is  used  to  compensate  for  modeling  errors  in  the  design 
process,  that  include,  uncertainties  due  to  unknown  leader  aircraft  acceleration,  and  the  modeling  error  due  to 
parametric  uncertainties  in  the  aircraft  aerodynamic  derivatives.  We  have  drawn  a  couple  of  conclusions  from  our 
design  process  and  simulation  results.  The  first  conclusion  is  that  adaptation  is  critical  to  the  stability  of  the  IGC 
design.  Secondly,  when  compared  to  an  adaptive  TSSGC  design,  the  adaptive  IGC  design  offers  an  explicit 
advantage  of  using  higher  gains  in  the  design.  In  the  case  of  the  time-scale  separated  design,  using  large  gains  in  the 
guidance  block  can  lead  to  large  commands  to  the  autopilot,  increasing  the  potential  for  actuator  saturation  and 
eventual  instability.  This  advantage  of  the  IGC  design  translates  into  better  transient  and  steady-state  range  tracking 
performance  as  seen  in  the  simulation  results. 

Future  research  involves  integrating  the  IGC  design  with  a  target-tracking  estimation  design  and  image 
processing  followed  by  flight  test  evaluations  of  the  complete  design  in  vision-based  formation  flight  of  a 
maneuvering  leader  and  follower  aircraft. 
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